from cocube import CoCube
import time
import numpy as np


agent = CoCube(1, gateway = "192.168.3.1", local_ip = "0.0.0.0")
uuid = agent.move_millisecs(duration = 2000)
# agent.rotate_millisecs()
while (True):
    time.sleep(0.01)
    flag, result = agent.judge_whether_finished(uuid)
    print(agent.pos_m)
    # if flag:
    #     print(result)
    #     print("successfully")
    #     break
